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(57)Abstract: 

PURPOSE: To make a robot walk stably even it moves on a place where 
two or more of planes such as rough terrain, etc. continue by providing a 
means to determine a walking so that a ZMP position obtained by 
dynamics is positioned at a set ZMP target position. 
CONSTITUTION: When a surface to be walked by a robot includes at 
least two planes of No.1 and No.2, a virtual No. 3 plane which varies 
continuously from the No.1 plane to the No.2 plane is assumed. Next, a 
ZMP target position of the robot is set virtually on it. Then a walking of 
robot is determined so that the ZMP position obtained by dynamics is 
positioned at the set ZMP target position to move the ZMP continuously 
even if the planes are different from each other. Here the ZMP means a 
point on a floor at which a moment caused by floor reaction in walking 
becomes zero. Thus the robot can walk stably even on rough terrains. 
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[88] 




Gc = (gcx, gey. gcz) ±m& 

Gcd = (gcdx, gcdy. acdz) 

Gcdd - (gcddx, geddy. gcddz) ±n*>tamg. 

mi ; J>7 i QfCft: 

Gci • (gcix, gciy, gciz) u>2 \ 4X6 

Gcdi - cgedix. gcdiy, gcdiz) u>jr i oai&ss 

Gcddi = (geddix, gedtiiy. gcddi2) i oSAtaM 

Ji = diog(Jix» Jiy t Jiz) u^? i ©Utt^vJUGEfl) 

Wi = fwix, wiy, wiz) u>7 i 

wdi = (wdix. wdiy. wdiz) \ <oftM«flr 



— n_yYx f Lwy» Lwz) 
Lwd = (Lwdx. Lwdy. Lwdz) *<o*#fc 



FaO fe*t&«$ 



LV = IGciXGcdi 4U>i7(DmiC>3iliCJ:SJi^^J© 

- clvx. lvv. Lvz) nmmmomn 

LVd = (LVdx. LVdy» LVdz) *-4>##fll 

g = (O.O.gz) »^fnSS^^HKgz=-9.8m/s^ 



FaO+rns=mGcdd 


Newton eq. 


■ 


M<jO-H3cx(mg)=Lwd-H_vd 


EuLer eq. 





